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File: smanc.cl 

Description: Improved Normalized Least Squares Lattice ANC 

Public Functions: SANC_Calc 

SANC I nit 


Notes : 


This version uses many of the same optimization techniques as the 
.asm version. 


History : 

HGK 04/29/93 


Design Note SDN 4 3 Rev A 


/define M0DULE_ID 

# include <masimo i h> 
# include <math . h> 


# include <smanc. h> 


1007 

/* platform descriptions 
/* self 


*/ 
*/ 


#dfefine MAX(a,b) (a) > (b) ? (a) : (b) 
#dSfine MIN(a,b) (a) < (b) ? (a) : (b) 


#d#fine MIN_VAL 
/define MAX_DEL 
#<Jefine MIN_DEL 
#<taf ine MAX_RH0 
#ciafine MIN_RH0 
/define MAX_BSERR 
/dfefine MIN BSERR 


0.01 

0.9999 9999999999,99 
-0.9999999 999999999 

2.0 
-2.0 

1.0 

1E-15 


/*.^The following macros provide efficient access to the lattice */ 


/dfWf ine 
#dWf ine 
#d¥f ine 
#def ine 
#def ine 
/define 
#def ine 
/define 
#def ine 
#def ine 
/define 


xBERR 

xBERR_l 

xtfELTA 

XDELTA_1 

XGAMMA 

XGAMMA_1 

XBSERR 

xBSERR_l 

XERR 

xFERR 

xRho 


0 
1 
2 
3 
4 
5 
6 
7 
8 
9 
10 


#def ine 


#def ine 
#def ine 


berr 

(MP 

+ 

xBERR) ) 

P_berr_l 

(MP 


xBERR 1 - SANC CELL SIZE)) 

P_berr 

(MP 

+ 

XBERR - SANC CELL SIZE) ) 

berr 1 

(MP 


X3ERR__1) ) 

Bserr 

(MP 

+ 

xBSERR) ) 

Bserr 1 

(MP 

+ 

xBS ERR 1 ) ) 

P^Bserr l 

(MP 

+ 

XBSERR_1 - SANC__CELL SIZE) ) 

P_delta 

(MP 


X DELTA - SANC CELL SIZE)) 


|V— ' — » delta) ) . 'l^r 

4 xDELTA_l) ) 


i'Hp f i np 

v.* v_. I. .1, | | V^. 

delta 1 





#def ine 

delta 1 




x DELTA 1) ) 

#def ine 

P _delta_l 

(* 

(p 

+ 

xDELTA_ 1 - SANG CELL SIZE) ) 

#def ine 

err 

(* 

(p 

+ 

xERR) ) 

#def ine 

N err 

(* 

(p 

-i- 

xF : :rr l- SANC ci ; :i,i. S 1 7, R) ) 

#def ine 

P_f err 

(* 

(p 

+ 

xFERR - SANC CELL SIZE)) 

#def ine 

f err 

(* 

(p 

4- 

XFERR) ) 

#def ine 

gamma 

(* 

(p 

+ 

XGAMMA) ) 

#def ine 

P gamma 

(* 

(p 

+ 

XGAMMA - SANC CELL_SIZE) ) 

#def ine 

N gamma 

(* 

(p 

+ 

XGAMMA + SANC CELL SIZE) ) 

#def ine 

P gamma 1 

(* 

(P 

+ 

XGAMMA_1 - SANC~CELL_SIZE) ) 

#def ine 

gamma_l 

(* 

(P 

+ 

XGAMMA_1) ) 

#def ine 

rho 

(* 

(P 

+ 

xRho) ) 


FLOAT 3 2 
SANC_Calc( 

SANC_DATA *anc, /* input, context handle */ 
FLOAT3 2 nps, ./* input, noise plus signal */ 

_^FLOAT3 2 noise) /* input, noise reference • */ 


{ 


WJINT3 2 m; 

y3 FLOAT32 *p; 

=t FLOAT3 2 B,F,B2,F2; 

W FLO AT 3 2 qd2,qd3; 

111 INT32 output_cell; ;/ 

U BOOL Bflag; 

s BUGl(anc); BUGl(nps); BUGl(noise); 

D /* Update time delay elements in cell structure 

p = (FLOAT32 *)anc->cells; 
for (m = 0; m <= anc->cc; m++) { 
r; gamma_l = gamma; 

berr_l = berr; 
Bserr_l = Bserr; 
delta_l - delta; 
p += SANC_CELL_SIZE; 

} 

/* Handle Cell # 0 

p = (FLOAT32 *)anc->cells; 

Bserr = anc->lambda * Bserr_l + noise * noise; 
Bserr = MAX(Bserr, MIN_BSERR) ; 

ferr = noise / SQRTF ( Bserr) ; 
ferr = MAX(ferr, MIN_DEL) ; 
ferr = MIN(ferr, MAX_DEL) ; 

berr = ferr; 

rho = anc->lambda * SQRTF ( Bser r_ 1 / Bserr) * rho + berr * nps; 
N__err = nps - rho * berr; 



(m = 
rho 
err 
f err 
berr 
berr_l 
delta 
delta_ 
Bserr 
Bserr_l 
gamma 
gamma_l 
P 


1 = 


g i m i l) — e- 

0.0, 
0.0, 
0.0, 
0.0, 
0.0, 
0.0; 

0.0; 

anc->min_error ; 
anc->min_errbr ; 
MIN^VAL; 
MIN_VAL; 
SANC_CELL SIZE; 


} 

p = ( FLOAT 3 2 *) anc->cells; 
gamma = 1.0; 
gamma_l = 1.0; 


/* Cell # 0 special case 


/* Initialize ^eJ^Bv'^B- 

output_cell = anc->cc - 1; 
Bflag = FALSE ; 

for (m = 1; m < anc->cc; m++) { 
p H-= SANC_CELL_SIZE; 


B = SQRTF (1.0 - P_berr_l * P berr 1); 
F = SQRTF(1.0 - P__ferr * p"ferr") ; 
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/* Assume last: cell for starter */ 


B2 = 1.0/B; 
F2 = 1.0/F; 


P_delta = P_delta_l * F * B + P_berr_l * P_ferr; 
P_delta = MAX(P_delta, MIN_DEL) ; 



qd3 


1.0 - P delta * P delta 


qd2 


1.0 / SQRTF (qd3 ) ; 


f err 


(P ferr 

- P delta * 


f err 


MAX (f err , 

MIN DEL) ; 


f err 


MIN(ferr, 

MAX_DEL) ; 


berr 


(P berr l 

- P delta * 


berr 


MAX(berr , 

MIN DEL); 


berr 


MIN(berr, 

MAX_DEL) ; 

#. 

gamma 


P_gamma * 

(1.0 - P berr 


gamma 


MAX (gamma , 

MIN VAL) ; 


gamma 


MIN (gamma ', 

MAX_DEL) ; 

U] 

Bserr 


P_Bserr_l 

* gd3; 


) * qd2 * F2; 


} 


/* update cell voter . */ 

if (Bserr < anc->voter && Bflag == FALSE) { 

outputcell = m; 

Bflag = TRUE; 

} 

Bserr = MAX(Bserr, MIN_BSERR) ; 

rhO *= anc->lambda * SQRTF ( (Bserrl / Bserr) * (gamma / gamma_l)); 

rho += berr * err; 

rho = MAX(rho, MIN_RHO) ; 

rho = MIN(rho, MAX_RHO) ; 

N_err = err - rho * berr; 


} 


p ~ (FLOAT32 *) & (anc->cells[output_ceJ 1 /* *ANC_CELL_SIZE */]); 
return (N err ) ; 


VOID 

SANC_Init ( 

SANC_DATA *anc) 

{ 

FLOAT 3 2 *p; 
INT3 2 m; 


/* input, context pointer 


BUG1 (anc) ; 


